ARTICULATED EQUIPMENT POSITION CONTROL SYSTEM AND METHOD 



CROSS-REFERENCE TO RELATED APPLICATION 
[0001] This application claims the benefit of U.S. provisional application No. 
60/432,719, filed December 1 1, 2002, which is incorporated herein by reference. 

BACKGROUND OF THE INVENTION 

1 . Field of the Invention 

[0002] The present invention relates generally to articulated equipment position control, 
and particularly to a system and method for DGPS-based positioning of an operative piece of 
equipment, such as a farm implement, which is pulled, pushed or carried by a motive piece of 
equipment, such as a tractor, by manipulation of a power-articulated connection 
therebetween. 

2. Description of the Related Art 

[0003] Various equipment systems include articulated components. For example, a 
common configuration involves a "motive" component, which supplies the motive force for 
pulling, pushing or carrying a "working" component through an articulated connection 
located therebetween. For example, tractors serve as motive components in agricultural and 
other operations. The working components can comprise various implements, which perform 
specific "working" functions. 

[0004] Articulated connections can be provided between such components to 
accommodate relative movement therebetween. For example, detachable hitches allow the 
equipment systems to be reconfigured in various combinations, depending on the task at 
hand. Moreover, such articulated interconnections commonly accommodate relative 
movement between the components. Common examples in agricultural equipment systems 
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include three-point hitches, clevis-type hitches, drawbars, etc. "Free" movement articulated 
connections include pivotal hitches. "Fixed" articulated connections include two-point and 
three-point hitches. Both types of articulated connections allow relative movement between 
the motive and working components. Such relative movement may be necessary to 
accommodate turning, as in the case of tractors pulling wheeled ground- working implements 
along curved travel paths, which are accommodated by pivotal hitches. Relative movement 
in the case of two-point and three-point hitches can involve adjusting implement height, pitch 
and other attitudes with respect to a tractor. 

[0005] An example of articulated equipment with GPS-based guidance capabilities is 
shown in U.S. Patent No. 6,539,303 for GPS Derived Swathing Guidance System, which is 
incorporated herein by reference. GPS guidance can utilize absolute positioning techniques 
based on GPS coordinates, or relative positioning based on previous travel paths and 
previously identified locations. Various error correction techniques are employed to improve 
the accuracy of GPS positioning. For example, Whitehead U.S. Patents No. 6,397,147 for 
Relative GPS Positioning Using a Single GPS Receiver with Internally Generated 
Differential Correction Terms and No. 6,469,663 for Method and System for GPS and 
WAAS Carrier Phase Measurements for Relative Positioning are assigned to CSI Wireless 
Inc. and are incorporated herein by reference. This technology is available from CSI 
Wireless Inc. under its trademark "e-Dif™". The Global Navigation Satellite System 
("GNSS") currently includes GPS, the GLONASS ("GLObal NAvigation Satellite System") 
satellites of the former USSR and other satellite ranging technologies. Current GNSS 
augmentation systems include WAAS (Wide Area Augmentation System) in the United 
States, EGNOS (European Geostationary Navigation Overlay System) in Europe and MSAS 
(Multifunctional Transport Satellite Space-based Augmentation System) in Japan. Each of 



these augmentation systems, which are all compatible, includes a ground network for 
observing the GPS constellation, and one or more geostationary satellites. 

[0006] Relatively precise GPS positioning can be achieved with real time kinetic 
("RTK") technology. For example, U.S. Patent No. 6,469,663 for Method and System for 
GPS and WAAS Carrier Phase Measurements for Relative Positioning discloses a single 
frequency RTK solution, and is incorporated herein by reference. Such greater precision can 
significantly expand the commercial applications for DGPS-based positioning and 
navigation. For example, in row crop agriculture, sub-meter tolerances are necessary to avoid 
equipment damage to crops. The application of DGPS-based automatic guidance offers the 
potential for reducing steering deviation associated with manual steering and guidance based 
on disk markers, foam markers and other prior art, non-automated techniques. However, 
guiding articulated agricultural equipment is particularly challenging because crop damage 
can be caused by either the motive or the working component, or both. 

[0007] The present invention addresses this problem by providing a system and method 
for positioning a working component relative to a motive component by a power-articulation 
of the hitch or other connection therebetween. Heretofore there has not been available an 
articulated equipment position control system and method with the advantages and features of 
the present invention. 

[0008] Other related art patents include: U.S. Patents No. 6,434,462 for GPS Control of a 
Tractor-Towed Implement; Nos. 5,51 1,623 and 5,664,632 for Quick Hitch Guidance Device; 
and No. 5,725,230 for Self Steering Tandem Hitch. 



SUMMARY OF THE INVENTION 
[0009] In the practice of the present invention, a system and method are provided for 
controlling the position of an articulated connection between motive and working 
components in an equipment system. The motive component can comprise a tractor or other 
piece of equipment, which is designed to pull, push or otherwise transport a working 
component, such as a ground-working implement, in an articulated equipment system. 
Control can be based on GPS positional data, and various types of DGPS (Differential GPS) 
controls can be used, including WAAS and other suitable error-correction functionalities. A 
relatively simple configuration with a single DGPS antenna solution can be used. This gives 
the operator guidance as well as providing a correction reference for the implement position. 
The system includes a DGPS receiver, which is preferably mounted on the motive vehicle. A 
control subsystem includes an on-board computer, which receives positional data from the 
DGPS receiver, processes same along with various other input data, and outputs signals that 
control the working component position through the articulated interconnection. The system 
and method have several operating modes, including "Follow GPS/Guidance' 1 whereby the 
connection maintains the position of the implement on a predetermined travel path. In a 
"Follow/Match Tracks" mode the articulated connection conforms the travel path of the 
implement to that of the motive component. A "Manual" operating mode is provided for 
direct operator control. Both straight-line and contour travel paths can be accommodated. 



BRIEF DESCRIPTION OF THE DRAWINGS 
[00010] Fig. 1 is a block diagram of articulated equipment with a DGPS-based position 
control system embodying the present invention. 



[00011] Fig. 2 is a schematic diagram of the position control system applied to 
agricultural equipment comprising a tractor and an implement with a power-articulated 
pivotal hitch. 

[00012] Fig. 3 is a communication diagram of the position control system shown in Fig. 2. 
[00013] Fig. 3A is a block diagram of the major components of the position control 
system, showing interrelationships therebetween. 

[00014] Fig. 4 is a front elevational view of an operator interface including the input and 

output devices for controlling and displaying the operation of the system. 

[00015] Fig. 5 is a top plan view of the tractor-and-implement system, shown with the 

articulated hitch correcting the implement position in response to a cross-slope field condition 

with the system in a Follow/Match Tracks, straight-line operating mode. 

[00016] Fig. 6 is an enlarged, fragmentary top plan view thereof. 

[00017] Fig. 7 is a top plan view of the tractor-and-implement system, shown with the 

articulated hitch correcting the implement position through a turn on a slope in a 

Follow/Match Tracks, contour operating mode. 

[00018] Fig. 7A is a top plan view of the tractor-and-implement system, shown with the 
articulated hitch correcting a steering deviation cross-track error with the system in a Follow 
GPS/Guidance, straight-line operating mode. 

[00019] Fig. 8 shows the operation of the system in a Follow DGPS/Guidance mode. 
[00020] Fig. 9 shows the operation of the system in a Follow/Match Tracks mode. 
[00021] Fig. 10 shows the operation of the system in an End Turn procedure. 
[00022] Fig. 1 OA is a table showing a Setup: Hitch Calibrate menu. 



[00023] Fig. 1 1 is a block diagram of a DGPS-based position control system for articulated 
equipment, which system comprises a first modified embodiment of the present invention 
with first and second DGPS receivers. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

I. Introduction and Environment 

[00024] As required, detailed embodiments of the present invention are disclosed herein; 
however, it is to be understood that the disclosed embodiments are merely exemplary of the 
invention, which may be embodied in various forms. Therefore, specific structural and 
functional details disclosed herein are not to be interpreted as limiting, but merely as a basis 
for the claims and as a representative basis for teaching one skilled in the art to variously 
employ the present invention in virtually any appropriately detailed structure. 
[00025] Certain terminology will be used in the following description for convenience in 
reference only and will not be limiting. For example, up, down, front, back, right and left 
refer to the invention as oriented in the view being referred to. The words "inwardly" and 
"outwardly" refer to directions toward and away from, respectively, the geometric center of 
the embodiment being described and designated parts thereof. Said terminology will include 
the words specifically mentioned, derivatives thereof and words of similar meaning. 

II. Preferred Embodiment Articulated Equipment System 2 

[00026] Referring to the drawings in more detail, the reference numeral 2 generally 
designates an articulated equipment position control system embodying the present invention. 
Without limitation on the generality of useful applications of the control system 2, equipment 



4 comprising a motive component 6 connected to a working component 8 through an 
articulated connection or hitch 10 is shown. Without limitation on the generality of 
articulated connections that can be utilized with the present invention, the hitch 10 can 
comprise, for example, an Adjustable Draw Bar Offset as shown and described in the Miller 
U.S. Patent No. 6,631,916, which is incorporated herein by reference. Such a hitch is 
available as an Outback Hitch product of RHS, Inc. of Hiawatha, Kansas. Also by way of 
example, the motive component 6 can comprise a tractor and the working component 8 can 
comprise a ground-working implement. However, the position control system 2 can be 
applied to other equipment configurations for a wide range of other applications. Such 
applications include equipment and components used in road construction, road maintenance, 
earthworking, mining, transportation, industry, manufacturing, etc. 

III. Control Subsystem 12 

[00027] The power-articulated connection 10 enables positioning the working component 
8 from the motive component 6 by means of a control subsystem 12. The control subsystem 
12 is associated with and mounted in the motive component 6, for example, inside the tractor 
cab thereof. The control subsystem 12 includes a microprocessor 14 which receives input 
signals from a DGPS receiver 16 connected to an antenna 18, which can be mounted on the 
roof of the tractor cab. The microprocessor 14 processes and stores the differentially 
corrected positional data received through the DGPS receiver 16. 
[00028] Fig. 2 shows an exemplary configuration of the control subsystem 12 with a 
steering guide 20, which can comprise an Outback S steering guide available from RHS, Inc. 
of Hiawatha, Kansas and manufactured by CSI Wireless Inc. of Calgary, Canada. The 
Outback S steering guide is described in U.S. Patent No. 6,539,303 for GPS Derived 
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Swathing Guidance System, which is incorporated herein by reference. The steering guide 
20 includes a steering display 21 with an arcuate array of steering indicator lights for guiding 
an operator along a travel path. An optional field mapping device 23 can be connected to the 
steering guide 20 by a CAN cable 25. The field mapping device 23 can comprise, for 
example, an Outback 360 device available from RHS, Inc. of Hiawatha, Kansas and 
manufactured by CSI Wireless Inc. of Calgary, Canada. A hitch position control device 27 is 
connected to the steering guide 20 through the CAN cable 25 and includes an arcuate hitch 
position display 42 with multiple indicator lights 44 (Fig. 4), as described in more detail 
below. The output devices connected to the control subsystem 12 include solenoid-controlled 
valves 22 for operating piston-and-cylinder units 24, which are operably connected to the 
hitch 10 and to an hydraulic fluid pressure source 62. The hitch 10 includes a pivotable draw 
bar 1 1 with a hitch pin 30 mounted at its trailing end for connecting the working component 
8. 

[00029] Fig. 3 is a communication diagram for the position control system 2. Fig. 3A is a 
block diagram showing the major components of the system 2 and some of the types of data 
and control signals, which are transmitted among the system components in operation. 
[00030] A hitch position control input/output ("I/O") user interface 26 includes a hitch 
guidance control panel 28 (Fig. 4). The control panel 28 includes indicators for "Follow 
GPS" mode 34, "Match Tracks" mode 36 and "Manual" mode 38. A mode selector switch 40 
is provided for sequentially cycling through the operating modes, as indicated by the 
indicators 34, 36 and 38. 

[00031] A downwardly-concave, arcuate hitch position indicator light array 42 comprises 
multiple left side (port) indicator lights 43, a center indicator light 44 and multiple right side 
(starboard) indicator lights 45. The lights 43, 45 can be color-coded (e.g., left = red and right 



= green). The amount of lateral hitch swing or deflection is proportionally indicated by the 
number of lights 43, 45 illuminated on either side of the center light 44. The control panel 28 
includes left and right switches 46a,b respectively, which are used for swinging the 
implement 8 left and right respectively. A "RUN" switch 48 is provided for initiating 
operation of the control subsystem 12. A "HOLD" switch 50 effectively pauses the control 
software. A "CENTER" switch 52 centers the hitch 10. The "S Present" indicator light 54 
indicates the operation of the steering guide 20, e.g. an "Outback S™" system. 
[00032] Additional input to the control subsystem 12 is provided by a potentiometer 56 
associated with a respective piston-and-cylinder unit 24 for indicating the extended/retracted 
condition thereof. The cross-track, curvature and tilt inputs are calibrated relative to the 
valve potentiometer 56 position. A tilt sensor 58 is mounted on the hitch 10 for indicating a 
tilt angle of the equipment 4, which input data are utilized in correcting for sloping field 
conditions. 

IV. Operation 

[00033] In one exemplary application of the system 2, a clevis-type, pivotal hitch 10 is 
power-articulated to adjust the position of a working implement 8 with respect to a tractor 6. 
A "Towed Point" at the hitch pin 30 is adjusted mechanically based on and in response to 
inputs, which can include: GPS-derived signals indicating cross-track error (i.e., steering 
error representing displacement from the desired track 32 (Fig. 7A)); GPS-derived speed; 
GPS-derived heading; and tilt as detected by the tilt sensor 58. 

[00034] The system 2 has three modes of operation: Follow GPS/Guidance, Follow/Match 
Tracks and Manual. 
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[00035] 1 . Follow GPS/Guidance Mode (Figs. 7A and 8). The system 2 corrects operator 
errors and course deviations by positioning the implement 8 on the desired track. Operation 
is in either straight mode (sometimes referred to as point A-to-point B or A-B guidance), 
where straight lines are followed (Fig. 7A), or contour mode (Fig. 8), where guidance is 
against a previously driven pass. Driver error is corrected through compensation by the hitch 
position on the towing vehicle 6 so that the working implement 8, and equipment thereon, are 
better positioned, which minimizes overlap and missed areas. In guidance mode, positional 
cross-track steering error information is provided by the steering guide 20, which can assist 
the operator in maintaining the tractor 6 on a desired travel path. Operator deviations from 
the desired travel path are accommodated by the control system 2, whereby the implement 8 
is maintained on course, regardless of operator-based errors and course deviations. The 
corrected travel path data are input to the control subsystem 12 based on actual hitch pin 30 
positions. Therefore, the system 2 is able to accurately track and record the travel path of the 
implement 8, regardless of the tractor 6 course deviations. Hitch position (hitch line) is 
calculated relative to the cab antenna 18 position. The hitch automatically maintains the 
hitch pin 30, and therefore the implement 8, on the desired track 32, compensating for tractor 
steering deviations (Fig. 7A). 

[00036] In Follow GPS/Guidance mode, the cross-track error of the GPS steering guide 
20, which is typically mounted on the tractor 6, from the present position to the desired track 
is used as the feedback element for the system. The guidance mode can be either straight 
(Fig. 7 A) or contour mode. The cross-track error is thus used to power-articulate the hitch 10 
to move it a corresponding amount up to its maximum travel. For example, if the DGPS 
navigation system 12 shows that the tractor 6 is six inches to the left of the GPS guideline or 
desired track 32, the hitch 10 will be moved six inches to the right, thus placing the hitch pin 



30 approximately over the desired track 32 (Fig. 7A). Using the GPS positioning data from 
the steering guide 20 and the hitch position signals from the potentiometer 56 through the 
hitch control 27, the hitch pin 30 position is maintained generally over the GPS guideline or 
desired track 32. The towed implement 8 is thus placed in the correct position. The system 2 
functions in this manner in both straight-line and contour submodes of the Follow 
GPS/Guidance operating mode. 

[00037] 2. Follow/Match Tracks Mode (Figs. 5-7 and 9). In this mode the system 2 
corrects for curvature and slope by positioning the trailer or implement 8 to follow in the 
tracks of the tractor 6. Otherwise the implement could slip down-slope and/or shortcut turns 
and cause damage by running over the crop rows. With the system 2 in Follow/Match Tracks 
operating mode, the hitch 10 is adjusted to compensate for tilting and curvature effects on the 
equipment 4. Such effects are encountered in fields with sloping and/or contour (i.e. curved 
travel path) conditions. The wheels of the pulled implement 8 will thus follow in the tracks 
of the tractor 6 in order to minimize crop damage. 

[00038] With "Follow Tracks" mode selected on the control panel (Fig. 4), the tilt sensor 
58 outputs a slope value. The system 2 will compensate for the slippage by moving the hitch 
10 up-slope (Figs. 5 and 6). Depending on load and soil conditions, this compensation value 
is variable and can be adjusted on-the-fly with the left and right arrow switches 46a and 46b 
respectively. 

[00039] At least five conditions are possible: a) straight/level, therefore no correction; b) 
straight/side slope, therefore correction for one variable; c) turn/level, therefore correction for 
one variable; d) turn/downhill, therefore correction for two variables; and e) turn/uphill (Fig. 
7), therefore correction for two variables. 
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[00040] 3. Manual Mode. In this mode the operator can manually control articulation of 
the hitch 10 through the left/right switches 46a/46b. The hitch 10 can be centered with the 
center switch 52 (Fig. 4). 

[00041] Fig. 10 shows an automatic turnaround detection feature, which is activated when 
the hitch 10 deviates more than a predetermined distance, such as two meters, from the 
guideline. It automatically swings the hitch 10 to a far outside-of-turn position. At the end of 
each pass, the control subsystem 12 detects such a deviation from a predetermined guidepath, 
or desired track 32, whereupon the system 2 enters an end-of-turn procedure to facilitate 
tightly turning the equipment 4. Such turns are typically "keyhole" turns. The implement is 
first turned in one direction and the hitch 10 is shifted to the outside of that direction, 
whereafter the operator turns the equipment in the other direction through more than 1 80 
degrees with the hitch 10 shifted to the outside of that turn, followed by a final turn with the 
hitch 10 shifting to the outside of the final turn. This feature avoids conflict between the 
components 6, 8 during tight turns, such as those which may be encountered at the ends of 
passes. At the end of each row when the vehicle is turning the operator typically carries out 
what is called a keyhole turn. This allows the vehicle and trailer to be turned in a minimal 
distance. In either Follow GPS/Guidance mode or Follow/Match Tracks mode, an automatic 
feature, without user intervention, is that curvature correction moves the hitch to the outside 
of the turn. This aids in the tightness of the turn achievable by a tractor and trailer by keeping 
the trailer away from the inside wheels. When the system 2 deviates from the desired track 
32 by more than a predetermined distance (e.g., about two meters), the end-of-turn procedure 
described above is automatically initiated. Thus, the operator can concentrate on completing 
the turn while the system 2 automatically positions the hitch 10 most advantageously. 
Automatic return to normal operation occurs after the turn is complete. 



-13- 



[00042] A technique to generate an accurate radius of curvature has been developed from 
the DGPS (Differential Global Positioning System) heading information. This value has 
been found to be proportional to the amount of hitch position movement required to make the 
implement 8 wheels follow those of the tractor 6. Similarly, a tilt sensor input is measured 
and calibrated to maintain the implement wheels in the tracks of the tractor wheels. The 
microprocessor 14 generates the required signals to activate the piston-and-cylinder unit 
hydraulic valves 22 whereby the hitch 10 accomplishes the required corrections. 
[00043] Curvature correction is calculated from the GPS information. Heading and speed 
are input whereby the system automatically generates the required radius of curvature. Using 
the heading information, typically generated at a rate of 5 Hz, the rate of heading change, can 
be calculated in degrees per second. A best fit algorithm of heading and time is used to 
reduce noise and generate a more stable rate of turn. By knowing the ground speed of the 
vehicle, the radius of curvature of any turn is calculable with the GPS positioning data inputs. 
With rate of turn ROT in degrees per second and speed S in meters per second, the radius of 
curvature R in meters can be generated from the formula: 

R = S*180/(pi*ROT) 
The line of travel that the hitch 10 has to travel in order to allow the trailer tires to follow in 
line with those of the tractor is inversely proportional to this radius of curvature value. The 
tighter the turn the more compensation is required up to the limit of the hitch movement. 
This proportional relationship is generally consistent for similar tractor/trailer configurations. 
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V. Calibration Process 

[00044] Fig. 10A shows a menu for calibrating the system 2 in a setup procedure. The 
menu appears on the steering display 21, which is part of the steering guide 20. Operator 
inputs are made via the steering guide 20 and the hitch guidance control panel 28 (Fig. 4). 
Position adjustment is accomplished by moving the hitch pin to its far left position with the 
left arrow switch 46a, then ENTER; moving the hitch pin to its far right position with the 
right arrow switch 46b, then ENTER; and centering the hitch with the CENTER switch 52, 
then ENTER. Curvature adjustment is accomplished by driving around a curve on relatively 
flat ground while observing the trailing implement tracking. The left and right arrow 
switches 46a and 46b respectively can be used to position the implement for accurate "Match 
Tracks' 1 positioning. The curvature compensation value is then updated by pressing ENTER. 
Slope calibration is accomplished by placing the tractor 6 on level ground with the slope 
function "ON", then ENTER to update the level reference value. 

VI. Error Correction 

[00045] (D)GPS errors can be: a) corrected as necessary using existing error-correction 
techniques, such as government-sponsored WAAS and EGNOS, commercially available 
differential services such as those supplied by OmniStar and RACAL, e-Dif differential 
techniques, and both local and wide area RTK methods. 

[00046] Improved positioning can be achieved by using two DGPS receivers, with 
antennas mounted on the tractor for operator guidance and on the implement for implement 
control, as discussed below. 
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VII. First Modified Embodiment Dual-Receiver System 102 

[00047] Fig. 1 1 shows articulated equipment 104 with a position control system 102 
comprising a first modified embodiment of the present invention. The system 102 includes 
first and second DGPS receivers 110, 112 mounted on motive and working components 106, 
108 respectively. This configuration can be used for automatic steering of the motive 
component 6 using the first DGPS receiver 1 10 and fine positioning of the working 
component (implement) 8 using the second DGPS receiver 112. 

[00048] It is to be understood that the invention can be embodied in various forms, and is 
not to be limited to the examples discussed above. Other components can be utilized. For 
example, the working component can comprise a sprayer with spray booms connected to a 
vehicle and adapted to be raised and lowered in response to GPS position data. 



